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Abstract 

Considerable attention, in the open literature, is being focused on the 
problem of developing a suitable set of deterministic dynamical equations for a 
complex spacecraft. This paper addresses the problem of determining a 
stochastic optimal controller for an n-body spacecraft. The approach used in 
obtaining the stochastic controller involves the application, interpretation, and 
combination of advanced dynamical principles and the theoretical aspects of 
modern control theory. The stochastic controller obtained herein for a 
complicated model of a spacecraft 

1) Uses sensor angular measurements associated with the base body 
to obtain smoothed estimates of the entire state vector 

2) Can be easily implemented 

3) Enables system performance to be significantly improved. 
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INTRODUCTION 


For deep-space missions, the requirements placed on antenna pointing, 
articulation control, science platform settling times, etc. tend to continually 
become more stringent. Moreover, to meet the objectives of the scientific 
experiments and to provide isolation from the radiation produced by the power 
source, booms are frequently employed. These facts dictate that a suitable 
spacecraft model must be determined and, in addition, that sensor noise and 
plant disturbances be accounted for! 

Considerable attention, in the open literature, has been focused on the 
problem of developing a suitable set of deterministic dynamical equations for a 
spacecraft ([l] through [5]). Recently, a particularly elegant albeit complicated 
set of dynamical equations for an n-hinged rigid-body spacecraft has been 
developed [2] . The salient features of this set of dynamical equations are 
(1) constraint torques do not appear, and (2) the number of variables involved is 
equal to the number of degrees of freedom of the system. Stochastic control 
theory has also been given special attention in the open literature. Ref. [6] is 
devoted exclusively to linear stochastic optimal control of linear systems subject 
to the average value of a quadratic cost functional. Stochastic optimal control 
theory has been successfully applied to such analytical problems as 

1) Obtaining a stochastic controller for a personalized rapid transit 
system [7] 

2) Obtaining a stochastic controller for achieving docking between an 
Orbit-to- Orbit Shuttle (OOS) and a malfunctioned satellite [8] 

3) Obtaining a stochastic controller for a single rigid-body model of a 
spacecraft [l l] . 
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In the present work, the objective is to determine a controller which makes 


use of the elaborate, deterministic model of the spacecraft and, in addition, 
accounts for sensor noise, disturbances, etc. In essence, an optimal stochastic 
controller is sought. However, because of the practical importance of ease of 
implementation, simplicity, and reliability, a suboptimal stochastic controller 
is determined. 

In obtaining the dynamical model for the spacecraft it is assumed that 
(see Fig. 1 ): 

1) The spacecraft (s/c) can be adequately modeled as n-hinged rigid 
bodies (with r degrees -of -freedom for the entire system) 

2) Chains of connected bodies do not form closed loops 

3) Only rotational motion at a joint is allowed 

4) A joint can be dissipative and elastic 

5) There is a vector constraint torque normal to the axis of rotation at 
a joint whenever the rotational motion has only one or two degrees 
of freedom. 

The approach used in this paper for obtaining the suboptimal stochastic 
controller for an n-hinged rigid body spacecraft involves the application, 
interpretation, and combination of advanced dynamical principles and the 
theoretical aspects of modern control theory. It is known that a solution can be 
found to a linear stochastic optimization problem involving a quadratic cost 
functional ([9] and [l 0] ). However, the plant representing the dynamics of the 
spacecraft is nonlinear. In addition, a single quadratic cost functional which 
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accounts for all of the desired characteristics of the controller cannot be found. 


Nevertheless, a suboptimal stochastic controller is obtained by: 

1) Appropriately linearizing the dynamical model of the spacecraft to 
obtain the plant 

2) Determining an appropriate model for the measurement process 

3) Invoking the "certainty-equivalence" principle of modern control 
theory 

4) Generating the suboptimal controller by passing the optimal 
controller for the linear stochastic problem through appropriate and 
desirable nonlinearities. 

The contributions of this paper include the casting of the dynamical 
equations for the spacecraft in a form suitable for optimal stochastic control 
theory and the development of a suboptimal stochastic controller. To the 
writer's knowledge, a stochastic controller based on a realistic model of a 
complex spacecraft has not been previously obtained. This paper shows how 
knowledge of an elaborate model of the spacecraft can be effectively used in the 
design of a suboptimal stochastic controller to improve performance.^ 

DYNAMICAL EQUATIONS FOR AN n-HINGED RIGID-BODY SPACECRAFT 

In this section, the dynamical equations for an n-hinged rigid-body 
spacecraft are provided. Emphasis is placed on the procedure used to obtain 
the results rather than on a detailed and lengthy derivation of the results. 
Consider an n-hinged rigid-body spacecraft having r degrees of freedom. The 


The stochastic controller presented in this paper is to be used in analyzing the 
cruise, the thrust vector control (TVC), and articulation control (ARTC) 
modes of the Mariner Jupiter Saturn (MJS'77) Spacecraft. 
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number of scalar constraint torques for such a system is n^ = 3n - r. A set of 
r dynamical equations in which the constraint torques do not appear is given 
below. The pivotal steps involved in obtaining this canonical set of equations 
involve (see [2], [3] and [5]): 

1) Recognizing that if the vector dynamical equations of all the bodies 
are summed, then the constraint torques cancel in pairs 

2) Noting that a vector constraint torque at a typical joint j can be 
isolated by summing the vector dynamical equations over all bodies 
that lie to one side of joint j (the constraint torques on this set of 
bodies all cancel in pairs, except for the one at joint j) 

3) Observing that the constraint torque (isolated in step 2) at joint j is 
orthogonal to the gimbal axis at joint j. 

Effectively, 3 scalar equations result from the projection of the vector 
equations summed over all the bodies onto a suitable reference frame. Moreover, 
r - 3 additional scalar equations result from the dot products of the r - 3 gimbal 
axes and the constraint torques associated with these axes. The salient 
advantage associated with the elimination of the constraint torques is the 
accompanying reduction of the computer time required for integrating the 
equations (this is especially true for large n)! 

The procedure used to arrive at the r scalar equations entails the 
following steps: 

1) Writing Newton's and Euler's equations for each body X 

2) Eliminating the unknown interaction force F 

h 

3) Evaluating the term 
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E 



X F. 


K j 


4) 


5) 


which represents the sum of the moments about the center of mass 
of body X due to interaction forces F existing at joint j 

\j 

Interpreting Euler's equations for body X (after using the results 
of step 3)) as the equations for the augmented body X relative to its 
barycenter 


Expressing the interaction moment M acting at joint j on body X 

C > 

as a sum of a constraint torque Mr' and a spring-damper torque 

A. . 


A/r SD • 

M , l. e. 


J 


M 


A/rC , Xyr SD . ,C 

C. = M x. +M X. = M x. + \ 

J J J J x j 


6) Recognizing that if the vector dynamical equations for the augmented 
bodies X are summed over all X, then the constraint torques cancel 
in pairs and consequently disappear, i. e. , 



X t S j e J ^ 



0 


7) Recognizing that the constraint torque at joint j acting on body X 
can be isolated by summing over all bodies to one side of joint j 

8) Recognizing that the gimbal axis g. is orthogonal to the constraint 

C 

torque M. at joint j. 
j 
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In vector -matrix notation, the equations aret: 



or 


A oj — L 


In scalar form the equations are 


00 


“o + 


r-3 

E 

k=l 


a 0k*k 


= L = 


n-1 

E 

\=o 


(i) 


( 2 ) 


r-3 n-1 


k=l \=0 

where 

n-1 n-1 



^=0 (JL=0 


E 




= 1 , 2 , 


r-3 


a i0 


w. 


E 


a ikY k 


= L. = 


*i 


a 


Ok 



tSee Definitions of Symbols for the definitions of all terms used in this paper. 
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A comparison of Eqs. (1) and (2) reveals that: 

1) Ajj is the 3x3 matrix representation of the operator a^p • (where 
a^Q is a dyadic, and * represents the dot product operation). 

2) ^12 * s ^ x r - 3 matrix representation of the vectors a^* 

3) -^22 * s r " ^ x r - 3 matrix representation of the scalars a.^ 

(with i, k = 1, 2, • • • , r-3). 

Moreover, in Eqs. (1) and (2), u>q represents the angular acceleration of the 
base body, represents the relative angular accelerations y ^ of the remaining 
n - 1 bodies, L n is a 3 x 1 matrix, and L R is a r - 3 x 1 matrix. 
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LINEARIZED SET OF r DYNAMICAL EQUATIONS FOR AN n-HINGED 
RIGID-BODY SPACECRAFT 

In this section, a linearized set of r dynamical equations for an n-hinged 
rigid-body spacecraft is provided. Linearization^ is accomplished by retaining 
only terms of first order in u>q, y^ and their derivatives in the solution (i. e. , 
products of Wq and y^ with k = 1, 2, • • • , r-3 and their derivatives are neglected). 
In addition, it is assumed that y^ (with k = 1, 2, • • • , r-3) and 0^ (with i = 1, 2, 3) 
are small angles -- hence the direction cosine matrices take a particularly 
simple form. 

Typical direction cosine matrices for the linearized case become (see, 
e. g. , Fig. 2) 


C 1 = E - v 2 i 2 

C 3 = E - y 4 g 4 

C l = E - b 

C 0 = C 1 C J = C E - V 2 g 2 ][E - V, Bj] - E - Vl g, - V 2 6 2 

c o = [ E - v 3 83] 

C 0 = C 3 C 0 = - v 4 84 - V 3 g 3 ] = E - y 3 g 3 - v 4 g 4 


0 

- e i 

6 2 


1 

9 1 

- 0 2 _ 

e l 

0 


= 

- e i 

1 

G 3 

_" e 2 

6 3 

0 


_ 6 2 

' e 3 

1 


^Products such as wgy and yy are neglected in the linearization in this paper; 
such terms can be retained and included in the forcing function L if it is 
desirable ! 
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where the vector 0 consists of ordered rotations 0^, 0^> 6j. E is a 3 x 3 
identify matrix, and a ~ over a vector represents the matrix representation of 
the cross-product operation. 

The relationship between the attitude rate and the angular velocity of the 
base body 0 becomes (for the linearized case) 



when the small angle assumption is used and in addition products of 0^ and 
are neglected. 

The elements a^^ can be evaluated for the linear case by recognizing that 
products of y^. and y^ and y^ and can be frequently neglected (for 
k = 1, 2, • • • , r-3). It is clear that only those portions of a ^ m that are not 
functions of y^. are to be retained. Recall from Eqs. (1) and (2) that the a ^ m ' s 
are the multipliers of <1 )q and d>^. Effectively, this implies that the direction 
cosine matrices (with k = 1, 2, • • • , r-3) appearing in the expressions for the 
a^ m 's can be approximated by identity matrices. The matrix A which is 
composed of the elements a ^ m then becomes a constant. 

The terms involved in the evaluation of the forcing function L are 
provided below for the linearized case. Recall that L is defined according to 
(see Eq. (1)) 

A ijj = L (5 ) 

where w consists of <I>q and and L consists of Lq and L^. 
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Recall, too, that Lq and L^, the components of L, are given by 


L 


0 



E 


X 



The linearized versions of E. and E ’ reduce to 

A. \ 


( 6 ) 


E 


X 


M + D. x F. 
K \ K 


+ / D. x C* F + > t» . 
L—i xp [x p Z_j Xj 

V-fr jtJ^ 


E 


X 


(7) 


and consequently, the linearized versions of Lq and reduce to 


L 


0 




+ D X x F X 


+ / D x x C X F 

/ > Xp p p 

p^X 



(8) 
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x j.J x 

is identically zero in the equation for L^ {interaction moments cancel in pairs). 

Compact Form for the Linearized Set of r Dynamical Equations 

In this section, the linearized set of r dynamical equations for an n-hinged 
rigid-body spacecraft are expressed in compact form. 

First, the term 

g i'£'.xX] T x 

X 

is examined. By summing the dynamical equations over bodies X, which are 
connected beyond gimbal axis g^ relative to the base body, the interaction 
moment at joint i on body X can be isolated. This implies that 

g i X) '^Xl V S Si ' Tii = g i ’ [” K i Y i ' B i Y i] g i (10) 

X J 
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where 


T ii " 


K.v.g. - B.v.g. 
1 ’i°i 1 'i°i 


In Eq. (10), and are the stiffness and damping coefficients associated with 
joint i. Substitution of Eq. (10) into Eq. (8) yields 


n-1 I n-1 S 

‘o-o-o+E D xo * c o F o + EK + D x * F x E ’V x c l h 
x=i J x=i / 4*X 

l v-to 


l g 1 ' £ 1X D xo x c o F o ‘ * K 1 V 1 + B 1 Y 1* 


+g i • v xc b f k! 


■ y~^ . e 2\ d ) 


x C 0 F 0 - < K 2 Y 2 + B 2 V 


€ 2X\ M X + D X x F X + Z-J D Xp xC P F p 


€ r-3,X D X0 x C 0 F 0 " * K r-3 Y r-3 + B r-3 Y r-3* 


+ g , • > € , . + D. x F. + > D. x C K F 

s r -3 / j r-3,X \ X X X / ; Xp p P 
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Equation (11) can thus be written as 



(12) 


or 



where 


0 is an appropriately dimensional null matrix 


K, B are r-3 x r-3 diagonal matrices composed of the stiffness coefficients 
Kj and the damping coefficients 

n-1 

L 00 = M 0 + D 0 X F 0 1 ■ D X0 x C 0 F 0 = M 0 + L 00 

X=1 


J 0R 


n-1 

E 

\=i 


. M + D x F + 

A. K \ 


X 

v-to 


D x x C X F 
Xp p ^ 


J R0 


f g l 22 'IX. D \o x c o F o 


g 2 ' 22 ' zx D 
X 


xo x c o F o 


E 


g r-3 * Z— I e r-3,X D X0 x C 0 F 0 
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n- 1 

f.E 

x=i 


Mx) m x + d x xP x + E d x 1 *’ cC ;; p h 

jJ^ X 


J RR 


n-1 


g 2 ■ y^i e 2x \ m \ + d \ x f \ d 

X=1 I uTk 


x, xC V f H 


X= 1 
n-1 


^3 
M-^O 


\ g r-3- Yj 


c , . x M + D. x F. 
r-3,\ ) X X X 


X= 1 


+ E v x *w i 

pTx 

p?£o 


^0 ~ L oo + l or m o + L oo + l or 


l r = l ro + l rr 


Collecting the above results, it follows that a set of r linearized dynamical 
equations for an n-hinged rigid -body spacecraft is given by 


1 — 

(M 

i-H 

< 

H 

H 

h) 

1 / 

A 2 1 j A 2 2 J 

to 



L 00 + L 0R 


l ro + L RR, 


0 

-K 


y + 


0 

•B 


(13) 


State Equations for an n-Hinged Rigid -Body Spacecraft 

In this section, the linear model developed in the last section is cast in a 
form suitable for use in modern control theory. Essentially, the state equations 
are sought. As seen previously, 


e ^ « 


o 


and 


y = w 
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where the vectors 0 and cOq are the attitude and angular velocity of the base 

body and the vectors Y andu^ represent the relative attitude and angular 

velocities Y, . Y, for k = 1,2, • **, r-3. The state can thus be defined as the 
k k 

2r x 1 vector 


|9 


x = 




Cl) 


R 


The differential equations for 0 and y are given above and those for and w R 
can be obtained from Eq. (13). 

Manipulation of Eq. (13) yields 


A 11 W 0 + A 12 w R ~ L 00 + L 0R L 0 

A 21 “o + A 22 “r = L R0 + L RR " Ky - By = L R - Ky - By 


(14) 


Equation (14) can be written as 


rl 


^0 “ _ A 11 " A 12 A 22 A 21_ ^ L 00 + L 0R ) 


- j^A n - A j2 A 22 A 2 J A 12 A 22 (L rQ + L rr - Ky - By) (15) 
W R = A 22 [ L R0 + L RR - k Y ~ b Y ‘ A zi w oj 
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Redefining the bracketed matrix in Eq. (15) as a, it follows that 


“0 = " _1 (L 00 + L 0R> - “ _1 A 12 A 22 { L R0 + L RR ' " B v} 

^R = A 22 { L R0 + L RR " K V - By} -A 22 A 2j co q 


(16) 


In vector -matrix notation, the state equations become 




to 


R 


"0 

0 

0 

0 


E 

0 

0 

0 


0 


a A 12 A 22 K 


- A 2 Z ^E+ A 2l a A 12 A 22 jK 


'fi 1 


0 


a A 12 A 22 B 




- A 2 2 ( E + A 2i a A i2 A 22* B 


-1 


W 



A 22 ( E ^ A 2 l a A 1 2 A 2 2 ) L R " A 22 A 21 Q ' L 0 


(17) 


where E is a 3 x 3 identity matrix and 0 is an appropriately dimensioned null 
matrix. Note that Eq. (17) has the desired form 


x = Fx + Gu 


where x is the state and u is the control vector (G is an identity matrix in 
this case). 
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Stochastic Controller for Multi-Hinged Rigid-Body Spacecraft 


In this section, a stochastic controller based on the dynamical model 
presented above is given. It is known from stochastic optimal control theory [9] 
that an optimal stochastic controller can be obtained for a linear problem subject 
to a quadratic cost functional. For the general nonlinear case, however, one 
must be content with a suitable suboptimal stochastic controller. In this work, 
the form of the stochastic controller appropriate for a linear problem subject 
to a quadratic cost functional is retained; however, the form of the control 
function for this special case is passed through desirable nonlinearities peculiar 
to attitude control before being applied to the plant (see Fig. 3). 

The models for the plant and measurement process are given by 


x = Fx(t) + Gu + w 
z = Hx(t) + v 


(19) 


where x is the state vector, u is the control vector, z is the measurement 
vector, H is the measurement matrix, F and G are the plant matrices, v is 
the measurement noise vector, and w is the plant noise vector. As is customary 
with Kalman filter theory and, without loss of generality, the noise processes w 
and v are assumed to be white and gaussian. The well-known Kalman-Bucy 
filter equations are given by [9] 

A A r A 

x = Fx + Gu + K £z - Hx J 

K = PH T R -1 (20) 

P = FP + FF T - KRK T + Q 
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where x is the estimate of the state, K is the Kalman gain matrix, P is 
covariance of the error in the estimate of the state, and the matrices R and Q 
are defined by 


E [w(t) - w(t)][w(-r) - w(t)] T = Q(t) 6(t - t) 
E [v(t) - v(t)] [ v( t) - v(t)] T = R(t) 6 (t - t) 


( 21 ) 


The values of the matrices Q, R used in the filter are based on engineering 
judgment; Q depends on disturbance torques, uncertainties in the dynamical 
model, etc. ; R depends on sensor errors. 


Generation of Suboptimal Controller 

❖ 

As stated above, the optimal control function u cannot, in general, be 

determined for the stochastic problem. For the linear case subject to the 

❖ 

average value of a quadratic cost functional, the optimal u can be determined. 
The equations characterizing this problem and its solution are given by [9] 


x 


z 


J 


F(t) x + G(t) u + w(t) 
H(t) x + v(t) 


E 


1 

2 " 


x T (t f ) S f x(t f ) + 





T — 

+ u B 


») 


dt 


PROBLEM 

FORMULATION 


u* = - Cx 
C = ¥ -1 G T S 

g = SF - F T F + C T BC - A; S(t f ) = 3 f 


! OPTIMAL 
CONTROL 
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x = F x + G u* + K(t) [z(t) - H x] 


T - 1 

K = PH R 


P = FP + PF T - KRK T + Q 


! 


FILTER 

EQUATIONS 


In this analysis, the suboptimal vector function Uq for the base body is 
obtained by 

1) Generating the actuating signal u used to fire the thrusters located 
on the base body according to 


u = C„ 0 + C oj n + C v V + C u> 

U)„ u Y 


'6 


"r r 


(23) 


2) Passing the function u through a vector deadzone function to obtain 
the applied moment and the associated applied thrust Fq acting 
on the base body; this contribution to Uq is given by 


M o =- 


XI l M o.| b i b i 


i= 1 


• DEZ u 


3) Generating the terms Lqq, 

The vector control function Uq is given by 


u 0 = a 


-X 

i= 1 


Mr 


T 

b.b. 
i i 


DEZ u + o' - 1 L q0 + o - ' L or 


- O' A 12 A 22 (L ro + L rr ) 


(24) 
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where Lq^i L^q, are defined in Eq. (12). Correspondingly, the 

vector control function for the remaining n - 1 bodies is given by 


u 


R 


_A 22 A 2 1 U 0 


+ A 22 * L R0 


+ l rr^ 


( 25 ) 


Note that the time-varying functions Lqqj L^, 


and L 


RR 


are based on V . 


Description and Uses of Suboptimal Stochastic Controller 

From Fig. 3, it is seen that the stochastic controller consists of a Kalman 
filter adjoined to the generators of Uq and u^. The measurement vector z, in 
this paper, consists of the sensed attitude angles of the base body. The 
estimated state x consisting of 6, y , is used to generate the actuating 
signal u which fires the thrusters located on the base body. In essence, the 
applied moment Mq tends to null a weighted combination of the attitude and 
angular velocity of the base body and the relative motion of the remaining n - 1 
bodies. Note that, if it is not desirable to null a specific relative motion y^ and 
its associated rate y, , then the appropriate components of the control gain 

K 

matrices C ^ and C w are zero. Note, too, that the system matrices A,,, 

R _ _ _ 

A,,.,, A, 0 , A 0 , , o are constant. The Kalman gain matrices K n , K , K , K. ; 
22 12 21 ° 0 w co V 

U x\ 

and the control gain matrices Cg, C u , C y , can be approximated by 

0 R 

piecewise constant functions, if it is so desired! 

This stochastic controller can be effectively used to study the effects of 
interactions of an articulated science platform on the base body motion, and to 
study the effects of interactions of booms on thrust vector control performance. 
In fact, this controller will be used to analyze the Mariner Jupiter Saturn 
(MJS'77) spacecraft in the cruise, the thrust vector control, and the 
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articulation control modes. The MJS'77 stringent accuracy requirements and 
settling times associated with the articulated science platform dictates that an 
elaborate dynamical model be used and that disturbances and sensor noise be 
properly accounted for. 
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DEFINITION OF SYMBOLS 


n 


Number of rigid bodies in spacecraft model 


n 

c 


r 


Number of constraints 
Number of degrees of freedom 


j 



m, m^ 


M 

M 


SD 

X. 

J 


A ir A 12’ A 21’ A 22 
A 


Integer used to designate a joint 

Set of labels for joints j belonging to body X- 

Set of labels of the ensemble of bodies X.p 

Vector from c. m. of body X. to joint j 

Interaction force and moment on body X due to joint j 

System mass; mass of body p 

Constraint moment at joint j on body X 

Spring -damper interaction moment on body X due to 
joint j 

Elements of partitioned matrix A appearing in Eq. (1) 
3+r-3x3 + r- 3 matrix appearing in Eq. (1) 


oj n , w , w Angular velocity vector of base body 0; relative angular 

(J K 

velocity components y^, k = 1, 2, • • • , r - 3; oo has 
components Uq and 

Lq, Lj^, L Vector forcing function for base body; vector forcing 

function for n - 1 remaining bodies; vector L has 
components L^ and 

a 00’ a 0k’ a i0’ a ik Dyadics defined in Eq. (2) 
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Y 


k 


,Y 


iX 



L 00’ l or 


L R0’ l rr 


F 


00 


b. 

1 

u 


E 


X’ 


E 


X 



<l> 


XH- 


Relative angular motion at joint k; y is r - 3 x 1 vector 
having components Y^» k = 1, 2, • • • , r-3 

I I if gimbal axis g^ is between body X and body 0 
0 otherwise 

Vector forcing functions used in defining L (see Eq. (12)); 
Lq and F^ are formed from Fp and Fj^ by not including 
the terms K Y + BY 


Vector forcing functions used in defining Fpj 
Lqq is the contribution to Fp due to forces Fp and 
moments Mp applied to the base body; Fp^ is the 
contribution made by forces F and moments M with 


Vector forcing functions used in defining F^; L^p is the 
contribution to due to F^; Fj^ is the contribution 
made by F^ and with X * 0 


Vector forcing function used in defining Fppj Fpp is 
formed from Fpp by not including the moment Mp 


Basis vectors for base body 0, i = 1, 2, 3 


Unit dyadic 


Vectors used in defining terms L and L of Eq. (2) 

u R 

is vector from barycenter of body X to joint j of 

j 

body X ; for all bodies p belonging to (the 

j j 

set of bodies connected to body X via joint j) 

A dyadic defined by = -m [ D xp • u ' D f^ D xp] 
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$ AA 

% 

°X 

F x’ M x 


E 


Augmented inertia matrix for body A relative to barycenter 
B A 

Gimbal axis, i = 1, 2, • • • , r-3 

Vector from barycenter of body X to c.m. of body X 

Vectors representing externally applied forces and 
moments to body X 

Direction cosine matrix transforming coordinates of 
body p. to coordinates of body X 

Unit (identity) matrix 


6 i* 



Attitude angles of base body 0; angular velocity measure 
numbers of base body 0, i = 1, 2, 3 


fv . 

3 

K., B. 

l i 
a 

K, B 

F, u, w, x 


z, H, v 


A, B, S, 


Vector representing spring-damper interaction torque 

SD 

on body X at joint j (same as M ) 

J 

Stiffness and damping coefficients for joint i 
Matrix used in state equations (see Eq. (17)) 

Diagonal stiffness and damping matrices 

F is matrix used in defining state equations (see Eq. (18)); 
u, w, x are vectors used in defining state equations (see 
Eq. (19)) 

z, v vectors used in defining measurement process; H is 
the measurement matrix 

Matrices used in defining average value of quadratic cost 
functional 
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c 


x, P, R, Q, K 


DEZ { } 


u 0’ U R 


Gain matrix used in defining controller u; C has 

components C-, C , C , C 

6 w 0 Y W R 

x is estimate of state x; P, Q, R, K are matrices 
appearing in filter equations (see Eq. (20)) 


Vector deadzone function 

Suboptimal control vector for base body 0; subcrptimal 
control vector for n - 1 remaining bodies 
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1 . B x IS BARYCENTER OF BODY X (X= 0 IN DRAWING). 

2. C x IS CENTER OF MASS (C.M.) OF BODY X. 

3. d x . IS VECTOR FROM C.M. OF BODY X TO JOINT j. 

4. S x . IS SET OF BODIES fi CONNECTED TO BODY X VIA JOINT j (SHOWN SHADED). 

5. D x IS VECTOR FROM B x TO C x . 

6. D.. IS VECTOR FROM B x TO JOINT j. 

*1 

7. D x#1 = D x . FOR ALL S Xj (IN ABOVE SKETCH, D 0j = D Q1 = D Q2 = D^ = = D Q5 = Dfl6 ). 


Fig. 1. Pictorial Sketch of 15-Hinged Rigid Bodies 
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1 . d. REPRESENTS VECTOR FROM C.M. OF BODY X TO JOINT j. 

A i 

2. g. REPRESENTS GIMBAL AXIS AT JOINT j . 

3. p. REPRESENTS HINGE POINT AT JOINT j. 

I 


Fig. 2. Pictorial Sketch of a 5-Hinged Rigid-Body 
Spacecraft Showing Gimbal Axes 
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